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abstract 


This  thesis  compares  two  types  of  command  guidance  to  be  used  by  a  point  defence  system; 
Proportional  Navigation  and  Command  to  Line  Of  Sight  (CLOS).  The  system  block  diagram  was  first 
defined.  The  necessary  transfer  functions  were  derived.  Two  forward  time  models  were  evaluated, 
one  for  each  guidance  method,  using  state  variable  analysis.  Two  three  dimensional  scenarios  were 
defined  and  their  results  used  to  compare  the  two  methods.  Parameters  considered  in  the  comparison 
were  miss  distance  and  acceleration  load  on  the  missile. 
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I .  INTRODUCTION 

The  term  "guidance"  implies  that  the  missile  responds  to 
steering  commands  in  order  to  improve  it's  accuracy  in 
delivering  the  warhead.  These  commands  issued  to  the  missile 
can  either  be  internal  or  external.  When  the  commands  are 
internal  the  missile  incorporates  a  seeker  that  tracks  the 
target  and  a  guidance  system  that  translates  the  target  data 
to  steering  commands.  This  being  the  case,  the  missile  is 
independent  from  the  platform  it  was  fired  from.  The  name 
associated  with  this  type  of  missile  is  "Fire  and  Forget". 
When  the  commands  are  external  the  target  data  can  be 
collected  by  a  Tracker/Fire  Control  System  on  the  firing 
platform.  The  guidance  system  calculates  the  desired  steering 
commands.  These  are  transmitted  to  the  missile.  This  implies 
that  the  missile  is  dependent  on  the  firing  platform 
throughout  the  encounter.  Command  is  the  name  of  this  type  of 
guidance.  A  generic  system  is  shown  in  Figure  1  [Ref.  l: 
pp.27]  . 

There  are  several  types  of  guidance  algorithms: 
proportional  navigation,  beam  rider  or  command- to -LOS,  etc. 

The  missile  incorporates  an  autopilot  by  which  the  signals 
are  transformed,  via  actuators,  into  turning  moments. 

The  missile  is  assumed  to  maneuver  via  "skid- to- turn" . 
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MISSILE 

TRACKER 

#2 

TARGET 

_ _ 

TRACKER 

#1 

Figure  1.  Generic  Command  Guidance 

System 

This  is  the  case  for  tactical  missiles.  When  the  target  is  at 
long  range,  the  missile  may  maneuver  by  a  "bank- to-turn" 
maneuvering  law.  This  is  a  "minimiam  control  effort"  concept 
that  increases  the  effectiveness  of  the  fuel  consumption  and 
thus  range . 

This  work  develops  a  missile/target  simulation  program 
using  proportional  navigation  and  beam  rider  command 
guidance.  A  three  dimensional  model  is  constructed  for  a  more 
realistic  approach  to  the  problem.  Chapter  II  introduces  the 
command  guidance  theory.  Chapter  III  develops  the  transfer 
functions  of  the  system,  the  problem  geometry,  and  the 
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relationships  that  are  to  be  simulated.  Chapter  IV  shows  the 
development  of  the  computer  code  and  relays  the  simulation 
results.  Chapter  V  discusses  the  conclusions  and 
recommendations . 

This  simulation  uses  MATLAB.  The  three  dimensional  plots 
are  generated  from  GRAFTOOL. 
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II. 


COMMAND  GUIDANCE 


A.  GENERAL 

Our  initial  approach  will  be  two  dimensional  [Ref.  2], 
Consider  the  geometry  in  Figure  2.  The  tracking  radar  (usually 
referred  to  as  the  illuminator)  measures  the  following  values: 

:  The  illuminator- to-missile  range. 

R,  :  The  illuminator- to- target  range. 

:  The  illuminator- to-missile  line  of  sight 

angle . 
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CT;  :  The  illuminator- to- target  line  of  sight 

angle . 

CRE  :  The  missile  Cross  Range  Error  from  the 

target  tracking  beam. 

From  these  measurements,  the  Fire  Control  System  solves  for 
the  following  values  : 

R  :  The  missile- to- target  range. 

R'  :  Rate  of  change  of  R. 

a  :  The  missile- to- target  line  of  sight 

angle . 

a'  :  Rate  of  change  of  a. 

The  guidance  system  of  the  Fire  Control  System  now  requires 
that  an  interception  can  occur.  This  can  happen  by  driving: 


0  =  0 
R  <  0 


(2.1) 


or,  by  driving: 


CRE  =  0 

(2.2) 

R  <  0 

More  insight  on  these  relationships  in  the  next  section.  But, 
for  now,  the  commands  issued  to  the  missile  will  affect  the 
following  values: 

v„  :  The  missile  velocity. 

:  the  missile  flight  path  angle. 

Finally,  we  know  that  the  solution  to  the  problem  also  depends 
on: 
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V,  ;  The  target  velocity. 

7,  :  The  target  flight  path  angle. 

We  will  use  here  the  Line  of  Sight  (LOS)  as  that  between 
the  target  and  the  missile.  This  so  as  to  reduce  the  quantity 
of  subscripts. 

B .  INTERCEPTION  THEORY 

The  problem  is  to  find  a  way  by  which  the  missile  can  hit 
the  target.  Figure  3  shows  several  techniques  developed  to 
solve  this  [Ref.  3:  pp.349].  "  Tail  Chase",  also  known  as 

"Pure  Pursuit",  is  the  trajectory  run  through  by  a  missile 
aiming  at  the  instantaneous  position  of  the  target.  "Three 


Figure  3 


Interception  Trajectories 


Point"  is  the  trajectory  run  through  by  the  missile  requiring 
the  three  points:  illuminator,  missile  and  target  to  be  on  the 
same  line  (LOS)  at  all  times.  These  two  techniques  require  a 
highly  maneuverable  missile,  able  to  withstand  high 
accelerations,  induced  by  the  large  change  of  the  missile 
velocity  vector,  during  the  final  seconds  before  impact  (this 
period  is  usually  referred  to  as  the  "endgame"). 

Three  point  guidance  is  usually  referred  to  as  Command- to- 
Line-Of -Sight  (CLOS)  .  This  is  based  on  the  minimization  of  the 
Cross  Range  Error  (CRE);i.e.  the  displacement  of  the  missile 
from  the  illuminator- to-missile  line  of  sight.  The  theory  of 
this  technique  is  that  since  the  three  points  are  always  on 
the  same  line  and  the  missile- to- target  distance  is  always 
shortening,  these  two  are  bound  to  meet.  This  explains  the 
relationships  of  Equations  2.2  of  the  previous  section. 

The  simplest  technique  of  all  is  the  "Constant  Bearing", 
also  known  as  "Optimum  Pursuit".  The  theory  behind  this 
technique  is  simple;  if  the  missile  "sees"  the  target  at  a 
constant  bearing  (a'=0)  and  if  the  distance  between  the  two  is 
continuously  closing  (R'<0),  then  the  missile  and  target  are 
bound  to  collide.  This  explains  the  relationships  of  Equations 
2 . 1  of  the  previous  section.  We  define  the  closing  velocity  as 
the  negative  rate  of  the  LOS  range: 

=  -R  (2.3) 
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The  benefits  of  this  technique  lie  in  the  smaller  acceleration 
requirements  during  the  endgame  phase.  Less  missile  energy  is 
also  required  [Ref.  4:  pp.  26].  The  guidance  law  associated 
with  this  technique  is  called  proportional  navigation. 

We  will  first  look  at  the  importance  of  the  LOS  angle 
rate,  since  this  is  a  major  factor  in  this  law.  Miss  distance 
is  the  minimum  missile- to- target  distance;  i  .  e .  it  is  the  range 
at  the  Closest  Point  of  Approach  (CPA)  .  Figure  4  displays  the 
configuration  examining  the  miss  distance  [Ref.  2:  pp. 33-34] . 
It  can  be  defined  as: 

=  min[i?(t)]  (2.4) 
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From  vector  theory,  a  vector  quantity  A  ,  rotating  with  an 


angular  rate  {ii-da / dt)  ,  is  differentiated  by  the  following 

law: 


dA 

dt 


dA 

dt 


(2.5) 


We  must  note  here  that  dA/dt  is  a  vector  parallel  to 


A  and  that  iixR  is  perpendicular.  This  leads  to  the 


incorporation  of  the  orthogonal  components  Ir  and  i„,  as  can 
be  seen  in  Figure  4.  Also  from  the  same  Figure  4,  we  can  see 
that,  an  incremental  increase  in  the  LOS  angle  (Aa) ,  modifies 
the  LOS  range  rate: 


RE 

At 


At  ° 


Az 

At 


+ 


An 
A 


(2.6) 


Taking  the  limit,  of  the  above,  as  t-*0,  we  have  the  derivative 
of  the  LOS  range.  Following  the  law  of  Equation  2.5  we  get: 


£  =  i  +  nx£  (2.7) 

Finding  the  acceleration  of  this  rate  again  requires  the  use 
of  Equation  2.5,  thus: 
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dt  at'  >  ^  I  (2.8) 

R  =  l  +  2axz+jixE+iLxsLxE 

This  acceleration  is  the  vectorial  difference  of  the  missile 
and  target  accelerations; i.e. : 

-a  ,  =  R  (2.9) 

target  missile 

Componentwise,  in  the  cross -range  direction  (parallel  to  i^)  : 

=  {Ra+2Ra)i„  (2.10) 

and  in  the  range  direction  (parallel  to  Ir)  : 

*  {R-Ro^)1r  (2.11) 

In  order  to  have  a  successful  intercept,  the  cross  range  rate 
of  the  LOS  must  be  zero,  thus  from  Equation  2.7,  the 

quantity  SL'xR  must  be  zero,  implying  either  the  LOS  range 

or  the  LOS  angle  rate  must  be  zero.  The  case  of  them  being 
parallel  is  not  physically  attainable.  Since  the  range  is 
generally  not  equal  to  zero,  we  are  left  with  the  zero  LOS 
angle  rate.  This  implies  that  the  LOS  angle  is  constant  and 
also  proves  the  first  part  of  Equation  2.1.  Furthermore, 
Equations  2.10-11  show  that  constant  LOS  angle  implies  equal 
missile  and  target  normal  acceleration  components.  Radial 
acceleration  components  difference  gives  the  closing 
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acceleration.  We  are  now  ready  to  develop  the  proportional 
navigation  law. 

C.  PROPORTIONAL  NAVIGATION  LAW 

The  acceleration  command  (a,)  issued  to  the  missile,  by 
the  proportional  navigation  law,  is  perpendicular  to  the  LOS. 
The  actual  missile  acceleration  (a^)  is  perpendicular  to  the 
missile's  velocity  {v„)  .  Figure  5  depicts  these  relationships 
[Ref.  11:  pp.  8-11]  .  We  now  seek  a  connection  between  the 
missile's  acceleration  and  its  flight  path  angle.  Figure  6 
depicts  this  relationship.  Given  the  missile  velocity  at  a 
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time  t(v„(t)),  assxaine  an  acceleration  (a„)  applied  on  the 
missile  for  a  period  of  dt.  The  velocity  at  the  end  of  this 
period  is  thus  v„(t+dt)  ,  The  flight  path  angle  has  been 
changed  by  d7„.  Assuming  a  small  angle  approximation,  a 
relationship  can  be  stated  as  follows: 


a 


m 


(2.12) 


But  the  proportional  navigation  law  is  given  by: 


Y„  =  Nd 


(2.13) 


where  N  is  the  proportional  navigation  constant.  The  law 
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states  that  the  rate  of  change  of  the  missile's  flight  path 
angle  is  proportional  to  the  rate  of  change  of  the  LOS  angle. 
Substituting  Equation  2.12  into  Equation  2.13  yields: 

(2.14) 

The  relationship  connects  the  missile  acceleration  to  the  LOS 
angular  rate.  The  navigation  constant  usually  ranges  between 
2  and  6 . 

D .  CLOS  LAW 

The  object  of  beam  riding  is  to  fly  the  missile  along  the 
beam  that  is  continuously  pointing  at  the  target.  The  command 
to  the  missile  is  again  an  acceleration.  From  Figure  2  we 
have : 

CRE  =  i?„sin(aj-o„)  (2.15) 

Thus  the  simplest  implementation  of  a  guidance  law  for  a  beam 
rider  system  the  missile  acceleration  command  (a^^d)  must  be 
proportional  to  the  cross  range  error,  thus: 

«3c«d  =  ‘K-CRE  =  K‘R^sin{o,-a^)  (2.16) 
where  K  is  the  guidance  gain  [Ref.  2:  pp.  45]. 
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III. 


SYSTEM  DEVELOPMENT 


A.  OVERVIEW 

In  order  to  approach  the  simulation  problem  we  will  first 
develop  a  block  diagram  of  the  system.  The  transfer  functions 
of  each  block  will  then  be  defined.  The  problem  geometry  for 
the  specific  application  will  then  be  developed.  Finally  the 
formulas  that  will  be  used  in  the  simulation  will  be  given. 

The  generic  block  diagram  of  a  command  guidance  system  was 
given  in  Figure  1.  A  more  specific  block  diagram  is  shown  in 
Figure  7 . 


Figure  7 . 


System  Block  Diagram 
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B .  TRACKER  DEVELOPMENT 


A  tracker  receives  the  radar  return  from  the  target,  and 
produces  the  illuminator- to- target  range,  and  yaw  and  pitch 
angles . 

The  yaw  plane  is  defined  as  the  xy- plane.  The  pitch  plane 
is  the  vertical  plane  containing  the  target  and  the  missile. 

1.  Proportional  Navigation 

The  tracker  geometry  is  shown  in  Figure  8.  From  this 
it  can  be  seen  that: 

:  The  missile  yaw  angle 

:  The  target  yaw  angle 
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(T„p  :  The  missile  pitch  angle 

:  The  target  pitch  angle 

R„  :  The  illuminator- to-missile  range 

R,  :  The  illuminator- to- target  range 

R  :  The  missile- to- target  range,  also  known  as 

the  Miss  Distance 

If  the  missile  is  defined  by  the  triplet  M (x,„,  y,„,  z,„) 
and  the  target  by  the  triplet  T{x,,y,,z,)  then,  the  Cracker 
calculates  the  following  relations: 


These  are  the  simulation  equations.  Inversely,  if  the  tracker 
values  are  known,  the  triplets  can  be  calculated  as  follows: 


- 

icoso^ 

Ym 

= 

'  ‘‘‘yaw 

= 

= 

iCOSO. 

i-vaw 

Yt 

= 

(R^coso^  ] 

\  ^  '-pitch} 

isino. 

2c 

= 

Resina  r 

^  '-pi  tch 

The  tracker  must  produce  the  following  values: 

:The  missile- to- target  yaw  angle 
cTpj^h  :The  missile- to- target  pitch  angle 

R  :The  Miss  Distance 

These  values  are  shown  in  Figure  9 .  The  above  required 
quantities  are  incorporated  in  the  solution  frame.  This  is 
defined  as  the  moving  frame,  always  parallel  to  the  reference 
frame,  but  originating  on  the  missile.  The  additional 
equations  required  to  be  solved  are: 


o 


yaw 


^ pi  tch 


R 


fan'^ 

{  Yt-Yn,\ 

tan'^ 

[>J{Xc-^mf*{Yc-Y„,f 

^{Vt-yrnf 


(3.3) 


The  combined  set  of  Equations  3.3  are  the  output  of 
the  tracker  for  a  proportional  navigation  fire  control  system, 
solving  the  three-dimensional  interception. 
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Figure  9.  Proportional  Navigation  Tracker  Solution  Frame 


Geometry 


In  this  case,  the  point  is  the  missile  and  the  line  is  the 
illuminator- to- target  range.  Substituting  the  triplets  for  the 
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Figure  10.  CLOS  Tracker  Geometry 

missile,  and  the  target,  T(x,,y,,z,),  the  following 

closed  form  solution  for  the  cross  range  error,  is  derived: 

^  ^  (Z^X,-Z,X^)-  (3.5) 

The  CRE  components  in  the  yaw  and  pitch  plane  can  also 
be  calculated.  Referring  to  Figure  10: 

+  yi  sin(o,^^^  - 

(3.6) 

=  sjCRE^  - 

The  signum  function  is  introduced  in  order  to  have  a  sign  for 
the  pitch  cross  range  error.  This  sign  is  transferred  to  the 
commanded  acceleration. 
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The  combined  set  of  Equations  3.5  and  3.6  are  the 
output  of  the  tracker  for  a  command- to- line -of  -  sight  fire 
control  system,  solving  the  three-dimensional  interception. 

C.  FILTER  DEVELOPMENT 

1.  Proportional  Navigation 

Proportional  navigation  guidance  requires  the  rate  of 
change  of  the  LOS  angle.  The  filter  estimates  this  rate  from 
the  LOS  angle  observed  by  the  missile. 

The  torque  that  will  be  applied  to  the  missile  will  be 
analogous  to  this  estimated  angular  acceleration  of  the  LOS 
angle.  The  equation  of  motion  describing  the  above  is: 

T  =  J-P  (3.7) 

where : 

T  :  Control  Torque 

I  :  Moment  of  Inertia 

/3  :  Estimated  LOS  angular  acceleration 

The  input  value  to  the  filter  is  the  LOS  angle.  The  output 
value  of  the  filter  is  its  estimation  of  the  angular 
acceleration.  In  between  it  calculates  the  angular  velocity  of 
the  LOS.  Thus  solving  for  Equation  3.7  we  get: 
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T 

I 


-iCi(P-O)  -iC2p 
-k2^-k^^+k^o 


(3.8) 


P  = 


where  k,,k2  are  constants  determined  by  the  time  constant  used 
by  the  tracker.  Laplace  transformation  transfers  Equation  3.8 
from  the  time  domain  to  the  s-domain.  Thus  Equation  3.8 
transformed  evaluates  the  filter  transfer  function: 


P  (g)  ^  1 

ois)  (s^+ic^s+JCi) 

Assume  the  relationship: 


(3.9) 


1 

(s^+k^s+kj) 


(3.10) 


For  the  system  a  time  constant  of  0.1  second  was  selected, 
since  it  approximates  current  technology.  So  the  constants  can 
be  defined: 


(3.11) 


The  block  diagram  and  S.F.G.  of  the  filter  is  shown  in  Figure 
11. 

From  Figure  11  it  can  be  seen  that  two  integrators  are 
incorporated  in  the  design.  We  can  further  analyze  the  system 
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Figure  11.  Proportional  Navigation  Filter  Development 
in  state- variable  form  to  be  described  by  the  following: 


~  (3.12) 


where  the  control  input  matrix,  for  our  scenario,  is: 


(3.13) 


The  vector  contains  the  pitch  and  yaw  plane 
estimations  of  the  angle  and  its  rate.  Thus  the  vector  can  be 
written  as: 
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X 


fie 


Ip 


pi  tch 
pitch 
yaw 
yaw 


(3.14) 


The  filter  A  and  B  matrices  can  then  be  written  as: 


0 

1 

0 

0  1 

0 

0  ■ 

■^flt  ~ 

-100 

0 

-20 

0 

0 

0 

0 

1  i 

Bfic  = 

100 

0 

0 

0 

0 

0 

-100 

-20j 

0 

100 

(3.15) 


This  representation  is  from  the  continuous . time  domain,  as  it 
was  transferred  to  the  s -domain.  Eventually  it  will  be  needed 
to  descritize  this,  in  order  to  run  the  computer  simulation, 

2 .  CLOS 

It  was  shown  previously.  Chapter  II  Section  D,  that 
the  cross  range  error,  in  a  two-dimensional  configuration, 
can  be  evaluated  as: 

» 

CRE  =  f?„sin(Oj-o„)  (2.15) 

It  was  also  stated  that  this  off-beam  error  will  be  used  as  an 
acceleration  command. 

In  order  for  good  response  characteristics  to  be 
obtained,  some  damping  is  required.  A  dynamic  equation  of  the 
form  : 
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( CRE)  =  a 


K^-(CRE)  +  K./{CRE) 


(3.16) 


cmd 


needs  to  be  satisfied.  The  error  is  thus  filtered  [Ref.  7: 
pp.l2].  Laplace  transformation  transfers  Equation  3.16  from 
the  time  domain  to  the  s-domain.  Thus  Equation  3.16 
transformed  evaluates  the  filter  transfer  function: 


CRE  is)  ^  1 


(3.17) 


The  filter  gain  constants  (K, .Kj)  assumed  here  are: 


=  -25 

=  -100 


(3.18) 


These  values  are  also  representative  of  the  current 
technology. 

The  block  diagram  and  S.F.G.  of  the  filter  is  shown  in 
Figure  12 .  From  this  it  can  be  seen  that  two  integrators  are 
incorporated  in  the  design.  We  can  further  analyze  the  system 
in  state- variable  form  to  be  described  by  the  following: 


‘■fit 


(3.19) 
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The  vector  contains  the  pitch  and  yaw  plane 
estimations  of  the  angle  and  its  rate.  Thus  the  vector  can  be 
written  as: 


tch 

CREy^^ 

CREy^^ 


(3.20) 


The  filter  A  matrix  can  then  be  written  as: 


A 


fit 


0  10  0 

-100  -25  0  0 

0  0  0  1 

0  0  -100  -25 


(3.21) 
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This  representation  is  from  the  continuous  time  domain,  as  it 
was  transferred  to  the  s- domain.  Eventually  it  will  be  needed 
to  descritize  this,  in  order  to  run  the  computer  simulation. 

D .  GUIDANCE  DEVELOPMENT 

1.  Proportional  Navigation 

The  guidance  subsystem  must  follow  the  proportional 
navigation  law,  as  this  was  stated  in  Equation  2.13.  The  only 
difference  would  be  that  the  estimation  of  the  angular  LOS 
rate  is  used  instead  of  the  actual  LOS  rate,  since  this  is  the 
input  from  the  filter  subsystem.  Thus; 

Y„  =  (3.22) 

This  is  also  the  control  input  transmitted  to  the  missile's 
autopilot . 

The  state  variable  representation,  for  our  case,  is: 

^srui  ~  ^gui  ^gui  ** 


^  ^picch 

N 

o' 

tch 

0 

N 

■^yaw  ■ 

2 .  CLOS 

A  generic  CLOS  guidance  would  generate  a  missile 
acceleration  equal  to  the  estimated  acceleration  of  the  cross 
range  error; i.e.: 
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(3.24) 


^cmd 

This  will  also  be  the  control  input  transmitted  to  the 
missile's  autopilot. 

The  state  variable  representation,  for  this  case,  is: 


^c:ndpicch 

'-25 

-100 

+1 

0 

0 

'CREy,, 

l^cmdy^^  . 

0 

0 

[CRE^icc^ 

i 

-25 

-100 

CREy^yy 

(3.25) 


E.  AUTOPILOT  DEVELOPMENT 

1 .  Proportional  Navigation 

The  autopilot  determines  the  control  (actuator 
position  and  thrust)  necessary  to  perform  the  required 
command.  In  proportional  navigation  guidance,  the  missile 
commands  are  generated  in  order  to  change  the  missile  flight 
path  rate  in  proportion  to  the  LOS  rate. 

A  simplified  autopilot,  would  respond  to  the  following 
argument  [Ref.  5:  pp. 17-19].  The  applied  torque  about  the 
missile  center  of  gravity  is  proportional  to  the  angular 
acceleration  of  the  missile  flight  path.  This,  equation  of 
motion  ,  stated  mathematically  yields: 

I-app  =  (3.26) 

where : 
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T,pp  :  The  applied  torque 

leg  :  The  moment  of  inertia  around  the 

missile's  center  of  gravity 
7m  :  The  angular  acceleration  of  the 

missile's  flight  path 

The  control  torque,  discussed  in  Chapter  III  Section 
C,  may  be  different  from  the  applied  torque.  Thus  solving 
Equation  3.26  for  the  flight  path  acceleration: 

Ym  =  ^  =  -ky^^kNti  (3.27) 

■‘■eg 


where  k  is  determined  by  the  slowest  time  constant  of  the 
missile/autopilot.  Laplace  transformation  transfers  Equation 
3.27  from  the  time  domain  to  the  s -domain.  Thus  Equation  3.27 
transformed  evaluates  the  autopilot  transfer  function: 


^  kN 

P  (s)  s  ^  k 


(3.28) 


For  the  autopilot  a  time  constant  of  1.0  second  was  selected. 
So  the  constant  can  be  defined: 


k  = 


=  1 


(3.29) 


The  autopilot  block  diagram  and  S.F.G.  are  shown  in 
Figure  13 .  From  this  it  can  be  seen  that  although  two 
integrators  are  incorporated  in  the  design,  only  one  output  is 
fedback.  We  can  further  analyze  the  system  in  state-variable 
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Figure  13.  Proportional  Navigation  Autopilot  Development 
form  to  be  described  by  the  following: 

•^ap  “  *'  ^ap  ^ap  (3.30) 

The  vector  contains  the  pitch  and  yaw  plane  flight 
path  angular  velocity  estimations.  Thus  the  vector  can  be 
written  as: 

(3.31) 

The  autopilot  A  and  B  matrices  can  then  be  written  as: 

(3.32) 
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The  control  input  matrix  is: 


(3.33) 


This  representation  is  from  the  continuous  time 
domain,  as  it  was  transferred  to  the  s-domain.  Eventually  it 
will  be  needed  to  descritize  this,  in  order  to  run  the 
computer  simulation. 

This  direction  change  rate  is  converted  to  an 
acceleration  command  to  the  actuators.  First,  the  missile 
velocity  must  be  analyzed  in  the  pitch  and  yaw  plane. 
Referring  to  Figure  14,  the  missile  velocity  vector  components 
can  be  stated  as  follows: 


'"pitch 

'"ydw 


|v.cosY.^„„l 


(3.34) 


The  spatial  accelerations  are  the  same  for  the  CLOS 
autopilot  and  are  derived  in  the  following  Subsection  2. 
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2 .  CLOS 

The  acceleration  commanded  is  distributed  by  the 
autopilot  into  the  missile's  spatial  accelerations.  Referring 
to  Figure  15 : 


^pi ccb 


=  -a 


^pi  tch 


sinop^.^^coso 


yaw 


‘pitch 


=  -an 


“‘pitch 


sinopi.^^sina 


yaw 


(3.36) 


and,  similarly,  for  the  yaw  plane: 


y™ 


'yaw 


-a 

-a 


sina 


COSO 


'"yaw 


yav 

yaw 


(3.37) 


From  the  above  relationships,  the  autopilot  states  can  be 
defined.  These  states,  as  well  as  those  for  proportional 
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navigation  guidance,  are  the  control  inputs  for  the  missile 
airframe.  So,  the  following  is  concluded: 


= 

^piCcJt 

=  V  V 

^pitch 

(3.38) 

=  2 

^pi tcb 

F .  ACTUATOR  DEVELOPMENT 

In  the  present  model,  and  for  both  guidance  cases,  the 
assumption  is  made  that  the  actuators,  also  known  as  control 
servos,  directly  convert  the  commanded  rate  to  fin 
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deflections.  This  being  the  case,  the  transfer  function  is 
unity . 


G.  AIRFRAME  DEVELOPMENT 


The  missile  vector  is  defined  as  the  missile's  spatial  and 
velocity  components,  namely; 


= 


ym 


(3.39) 


Thus  the  missile  can  be  represented  as; 


(3.40) 


The  control  input  matrix  is; 


Ym 


(3.41) 


Thus  the  A  and  B  matrices  can  be  written  as  follows 


0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

A  S.F.G.  representing  the  missile  dynamics  for  the  y-axis 
and  for  both  guidances  is  shown  in  Figure  16. 
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H.  KINEMATICS  DEVELOPMENT 


The  airframe  development  also  defines  the  missile 
kinematics.  The  target  kinematics  are  derived  in  a  similar 
fashion.  The  target  can  be  described  by  a  state  equation, 
namely: 

(3.43) 

where : 


(3.44) 


0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

St= 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

0 

1 

(3.45) 


(3.46) 

The  target  dynamic  equations  are  defined  with  respect  to 
the  trajectory  it  follows;  for  example  if  the  target  is  at 
level  flight  the  accelerations  are  zero  and  so  is  the  control 
matrix. 

The  S.F.G.  for  the  target  kinematics,  for  the  y-axis,  is 
shown  in  Figure  17. 
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Figure  16.  Airframe  Development  (detail) 


I.  SIMULATION  DEVELOPMENT 

In  order  to  simulate  the  system  some  variables  are 
required  for  checking  the  results  and  the  validity  of  the 
assumptions.  Also  the  discretization  of  the  system  needs  to  be 
addressed. 

1.  Additional  Calculations 

The  missile- to- target  range  (R)  can  also  be  defined 

as : 

R  =  V,  (3.47) 


where : 

Vj  ;  the  closing  velocity 
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tgo  :  the  time-to-go  until  impact;!. e.  the 

initial  value  must  equal  the  total 
flight  time  (tcpA) 

The  closing  velocity  was  defined  in  Equation  2.3. 
Referring  to  Figure  18: 


=  -R  =  V, 


,cos(Y, 


-o, 


(3.48) 


A  similar  analysis  can  be  done  in  the  pitch  plane,  but 
the  idea  is  to  subtract  the  missile  and  target  velocity 
components  parallel  to  the  projection  of  the  miss  distance  in 
either  the  yaw  or  the  pitch  plane. 

Thus  the  time-to-go  can  be  calculated  as: 


t 


yo 


_R_ 

-R 


_R 


(3.49) 


2 .  System  Discretization 

For  a  continuous  time  state- space  system  described  by 
the  following  set  of  equations  [Ref.  8] : 
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Figure  18.  Closing  Velocity  Geometry 


x(  C)  =  Ax(  t)  +  Bu(t) 
yit)  =  exit)  *  Du(t) 


(3.50) 


a  transformation  into  a  discrete  time  system,  with  a  T  time 
interval,  can  be  achieved: 

x(;c+l)  =  9x(k)  +  ru(ic) 
yik)  =  Cxik)  +  Du(k) 


according  to  the  transformation  equations; 


(3.52) 


One  way  of  calculating  the  matrix  exponent  is: 
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qAT  _  -1] 

t=T 


«  2  7-'2  a  3  T’3 

=  J3-AT-*-  -  4-... 


2  ! 


3  ! 


(3.53) 


For  the  simulation  the  MATLAB  function  C2D.M  is 
utilized.  This  function  produces  the  ^  and  r  when  the  A  and  B 
matrices  as  well  as  the  time  interval  (T)  are  specified. 
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IV. 


SIMOLATION  RESULTS 


A.  OVERVIEW 

The  computer  code  for  the  proportional  navigation  command 
guidance  is  presented  in  Appendix  1,  and  that  for  the  command- 
to- line -of  -  sight  in  Appendix  2.  The  assumptions  that  have  been 
made  throughout  will  be  discussed.  The  two  scenarios  run  and 
their  results  will  also  be  presented. 

B .  ASSUMPTIONS 

The  following  assumptions  have  been  made  throughout  the 
analysis  and  simulation: 

•  The  missile  is  not  limited  in  accelerations. 

•  The  acceleration  due  to  gravity  is  ignored. 

•  The  target  is  capable  of  instantaneous  acceleration. 

•  The  target  has  no  upper  acceleration  limit. 

•  The  proportional  navigation  constant  is  4. 

•  The  missile  is  pointed  to  the  target  at  launch. 

C .  ENGAGEMENT  SCENARIOS 

1.  Target  at  Steady,  Level  Flight 

For  this  scenario  the  target  is  flying  at  a  constant 
altitude  with  no  acceleration.  The  missile  is  fired  from  the 
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origin  of  the  reference  frame.  The  initial  conditions  of  the 
missile  states  are: 

=  0  [ft] 

=  3000  [ft/sec] 

y.  =  0  [^t] 

(4.1) 

y.^  =  0  [ft/ sec] 

=  0  [ft] 

=  0  [ft/ sec] 

The  initial  target  states  are  such  that  the  target  would  pass 
above  the  launching  platform: 


= 

30000 

[ft] 

= 

-999.445 

[ft/sec] 

Vc 

= 

1000 

[ft] 

Vc 

= 

-33.315 

[ft/sec] 

= 

500 

[ft] 

s 

0 

[ft/sec] 

The  target  control  matrix  inputs  are: 

Xj.  =  0  [ft/sec^] 
Yf.  =  0  [ft/sec^] 
=  0  [ft/sec^] 


(4.2) 


(4.3) 


2 .  Maneuvering  Target 

For  this  scenario  the  target  is  accelerating  in  all 
three  directions.  The  missile  is  fired  from  the  origin  of  the 
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reference  frame.  The  initial  conditions  of  the  missile  states 
are: 

=  0  [^t] 

=  3000  [ft/ sec] 

y,  =  0  [ft] 

(4.4) 

y,  =  0  [ft/ sec] 

=  0  [ft] 

z. ^  =  0  [ft/ sec] 

The  initial  target  states  are  such  that  the  target  would  pass 
above  the  launching  platform,  if  it  was  at  level  fight: 

=  30000  [ft] 

Xf.  =  -999.445  [ft/sec] 

y,  =  1000  [ft] 

(4.5) 

y^  =  -33.315  [ft/sec] 

Zj  =  900  [ft] 

Zj  =  0  [ft/sec] 

The  target  control  matrix  inputs  are: 


-6 . 5-32 . 2  siny^ 

[f  t/sec^] 

-6.5-32.2  cosY^ 

[f  t/sec^] 

(4.6) 

^ymw 

-0.1-32.2  cosYr 

•  ^piccb 

[f  t/sec^] 
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D .  RESULTS 


Figures  19  through  38  display  the  output  of  the 

proportional  navigation  code  for  the  first  scenario. 

Figures  39  through  58  display  the  output  of  the 

proportional  navigation  code  for  the  second  scenario. 

Figures  59  through  80  display  the  output  of  the  CLOS  code 
for  the  first  scenario. 

Figures  81  through  102  display  the  output  of  the  CLOS  code 
for  the  second  scenario. 
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Figure  20.  Proportional  Navigation  Scenario  1:  Missile 
and  Target  x- coordinate  Time  History 


43 


oord.  (ft| 


Missile 


Figure  21.  Proportional  Navigation  Scenario  1: 

and  Target  y- coordinate  Time  History 


Figure  22.  Proportional  Navigation  Scenario  l:  Missile 
and  Target  z- coordinate  Time  History 
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Vx  [ll/s] 


Figure  24.  Proportional  Navigation  Scenario  1:  Missile 
and  Target  Velocity  (x- component )  Time  History 
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are  25.  Proportional  Navigation  Scenario  1:  Missile 
and  Target  Velocity  (y- component)  Time  History 


2— Velocity  Tim#  History 


Figure  26.  Proportional  Navigation  Scenario  1:  Missile 
and  Target  Velocity  (z- component)  Time  History 
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Figure  27.  Proportional  Navigation  Scenario  1: 
Pitch  Angle  Time  History- 


Missile 
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Figure  28.  Proportional  Navigation  Scenario  1: 
Yaw  Angle  Time  History 


Missile 
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Figure  32.  Proportional  Navigation  Scenario  l:  Miss 
Distance  and  Time -of -Closest -Point -of  Approach 
Enhancement  Plot 
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Figure  33.  Proportional  Navigation  Scenario  1:  Missile 
Total  Acceleration  Time  History 


x>*>Acc«i«rot!on  vs.  Tlmo 


Figure  34.  Proportional  Navigation  Scenario  1:  Missile 
Acceleration  (x- component)  Time  History 
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Figure  35.  Proportional  Navigation  Scenario  l:  Missile 
Acceleration  (y- component )  Time  History 


Figure  36.  Proportional  Navigation  Scenario  1:  Missile 
Acceleration  (z-component)  Time  History 
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Figure  37.  Proportional  Navigation  Scenario  1:  Three- 
Dimensional  Plot  of  the  Engagement 
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Figure  38.  Proportional  Navigation  Scenario  1:  Yaw  Plane 
Projection  of  the  Engagement 
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-COOfd. 


Figure  39.  Proportional  Navigation  Scenario  2:  Time-To- 
Go  vs.  Missile- to-Target  Range 


Figure  40.  Proportional  Navigation  Scenario  2:  Missile 
and  Target  x- coordinate  Time  History 


54 


y  — COO»-ai»^Ot«  •^■■tory 

«ooo  : - -  - — ,- 


Figure  41.  Proportional  Navigation  Scenario  2:  Missile 
and  Target  y- coordinate  Time  History 


Figure  42.  Proportional  Navigation  Scenario  2:  Missile 
and  Target  z- coordinate  Time  History 
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Miss 


Figure  43.  Proportional  Navigation 
Distance  Time  History 


Figure  44.  Proportional  Navigation  Scenario  2:  Missile 
and  Target  Velocity  (x- component )  Time  History 
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Figure  45.  Proportional  Navigation  Scenario  2:  Missile 
and  Target  Velocity  (y- component)  Time  History 


Figure  46.  Proportional  Navigation  Scenario  2:  Missile 
and  Target  Velocity  (z-component)  Time  History 
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Figure  47.  Proportional  Navigation  Scenario  2:  Missile 
Pitch  Angle  Time  History 


Figure  48.  Proportional  Navigation  Scenario  2:  Missile 
Yaw  Angle  Time  History 
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Figure  51.  Proportional  Navigation  Scenario  2:  Closing 
Velocity  Time  History 


Enhancement  Plot 
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Figure  53.  Proportional  Navigation  Scenario  2: 
Total  Acceleration  Time  History 
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Figure  56.  Proportional 
Acceleration 


62 


Figure  57.  Proportional  Navigation  Scenario  2: 

Dimensional  Plot  of  the  Engagement 


Three - 
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Figure  58.  Proportional  Navigation  Scenario  2:  Yaw  Plane 
Projection  of  the  Engagement 
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Figure  59.  CLOS  Scenario  1:  Time-To-Go  vs  Missile- to- 
Target  Range 


coordinate  Time  History 
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Figure  62.  CLOS  Scenario  1:  Missile  and  Target  z- 

coordinate  Time  History 
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Figure  63 .  CLOS 


Scenario  1:  Miss  Distance  Time  History- 


Figure  64.  CLOS  Scenario  1:  Missile  and  Target 

Velocity  (x-component)  Time  History 
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Figure  66.  CLOS  Scenario  1:  Missile  and  Target 

Velocity  ( z -  component )  Time  History 
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Figure  70.  CLOS  Scenario  1:  Miss  Distance  and  Time-of- 
Closest- Point -of  Approach  Enhancement  Plot 
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Figure  72.  CLOS  Scenario  1;  Missile  Acceleration  (x- 

component)  Time  History 
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Figure  73.  CLOS  Scenario  1:  Missile  Acceleration  (y- 

component)  Time  History 


Flgrure  74.  CLOS  Scenario  1:  Missile  Acceleration  (z- 

component)  Time  History 
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Figure  75 


CLOS  Scenario  1:  Three-Dimensional  Plot  of 
the  Engagement 
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Figure  77.  CLOS  Scenario  1:  Missile  Cross  Range  Error 

(Yaw  component)  Time  History 


Figure  78.  CLOS  Scenario  1:  Missile  Cross  Range  Error 

(Pitch  component)  Time  History 
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Figure  79.  CLOS  Scenario  1:  Total  Missile  Cross  Range 

Error  Time  History 


Figure  80.  CLOS  Scenario  1:  Total  Commanded  Missile 

Acceleration  Time  History 
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Figure  81.  CLOS  Scenario  2:  Time-To-Go  vs .  Missile- to- 
Target  Range 


Figure  82.  CLOS  Scenario  2:  Missile  and  Target  x- 

coordinate  Time  History 
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Figure  83.  CLOS  Scenario  2:  Missile  and  Target  y- 

coordinate  Time  History 


Figure  84.  CLOS  Scenario  2:  Missile  and  Target  z- 

coordinate  Time  History 
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Figure  85.  CLOS  Scenario  2:  Miss  Distance  Time  History 


Figure  86.  CLOS  Scenario  2:  Missile  and  Target 

Velocity  (x- component)  Time  History 
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Figure  87.  CLOS  Scenario  2:  Missile  and  Target 

Velocity  (y- component)  Time  History 


Figure  88.  CLOS  Scenario  2:  Missile  and  Target 

Velocity  ( z - component )  Time  History 
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Scenario  2: 


Missile  Pitch  Angle  Time 


Figure  89 .  CLOS 

History 


Figure  90.  CLOS  Scenario  2:  Missile  Yaw  Angle  Time 

History 
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Figure  93 


CLOS  Scenario  2:  Missile  Total  Acceleration 
Time  History 


Figure  94.  CLOS  Scenario  2:  Missile  Acceleration  (x- 

component)  Time  History 
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Figure  95.  CLOS  Scenario  2:  Missile  Acceleration  (y- 

component)  Time  History 


Figure  96. 


CLOS  Scenario  2:  Missile  Acceleration  (z- 

component)  Time  History 
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Figure  97.  CLOS  Scenario  2:  Three-Dimensional  Plot  of 
the  Engagement 
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Figure  98.  CLOS  Scenario  2:  Yaw  Plane  Projection  of  the 
Engagement 
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Figure  99.  CLOS  Scenario  2:  Missile  Cross  Range  Error 

(Yaw  component)  Time  History 


c»ttcH  CRE 


Figure  100.  CLOS  Scenario  2:  Missile  Cross  Range  Error 

(Pitch  component)  Time  History 
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Figure  101.  CLOS  Scenario  2:  Total  Missile  Cross  Range 

Error  Time  History- 


Figure  102.  CLOS  Scenario  2;  Total  Commanded  Missile 

Acceleration  Time  History 
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A.  COZIPARISONS 


1.  Scenario  1 

For  the  case  of  the  level  flying  target  the 
proportional  navigation  algorithm  gave  (after  a  few  computer 
runs)  the  following  results: 

•  Miss  Distance  31.7  [ft] 

•  tcPA  7.52  [sec] 

The  CLOS  algorithm  gave: 

•  Miss  Distance  19.3  [ft] 

•  tcpA  7.57  [sec] 

The  difference  in  miss  distance  can  be  found  in  the 
missile  acceleration.  The  total  missile  acceleration  plots 
show  the  absolute  values.  Whereas  the  proportional  navigation 
guidance  commands  large  values  in  the  first  second  of  flight, 
these  values  are  much  smaller  than  those  commanded  by  the 
CLOS.  In  the  case  of  the  CLOS,  these  commands  are  issued  each 
time  the  missile  is  off-becim.  Also,  when  the  illuminator- to- 
target  and  illuminator- to-missile  ranges  are  of  the  same 
order,  range  resolution  requires  more  off-beam  (CRE)  error. 
Then  the  commanded  acceleration  values  are  even  higher  than 
before.  The  total  CRE,  at  the  time  of  closest  point  of 
approach,  is  then  the  miss  distance. 
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There  is  no  distinct  difference  in  the  total  flight 
time,  but  all  computer  runs  showed  a  consistent  lower  flight 
time  for  the  proportional  navigation  guidance  in  the  order  of 
hundredth  of  a  second. 

2 .  Scenario  2 

For  the  case  of  the  maneuvering  target  the 
proportional  navigation  algorithm  gave  (after  a  few  computer 
runs)  the  following  results: 

•  Miss  Distance  63.4  [ft] 

•  tcPA  7.20  [sec] 

The  CLOS  algorithm  gave: 

•  Miss  Distance  12.1  [ft] 

•  tcpA  7.21  [sec] 

The  same  miss  distance  analysis,  outlined  in  the 
previous  subsection,  holds  here  also.  But  in  this  case,  the 
proportional  navigation  guidance  gives  a  much  higher  miss  than 
that  of  the  CLOS. 

The  large  acceleration  demands  impose  large  pitch  and 
yaw  angles.  These,  in  turn,  modify  the  velocity  vectors,  and 
finally  the  trajectory. 
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V. 


CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

Although  the  proportional  navigation  scheme  may  be  an 
excellent  tool  for  inertial  guided  missiles,  command  guidance 
offers  attractive  alternates. 

In  the  case  of  beam  riding,  the  missile  does  not  require 
a  seeker,  thus  reducing  the  unit  production  cost.  On  the  other 
hand,  the  illuminator  is  required  to  remain  occupied  with  the 
target  until  intercept.  Also  the  accuracy  varies  inversely 
proportional  with  the  range  of  intercept ; i . e .  targets  engaged 
close  to  the  illuminator  produce  higher  range  resolution  than 
targets  further  away. 

The  algorithms  developed  provide  an  insight  to  the  two 
different  guidances.  Proportional  navigation  gave  higher  miss 
distances  as  the  target  increased  its  maneuverability,  whereas 
CLOS  remained  consistent  throughout. 

B .  RECOMMENDATIONS 

The  application  of  an  acceleration  limit,  would  be  an  easy 
addition  to  the  algorithms  and  would  provide  further  insight 
to  the  comparison. 
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The  implementation  of  noise  in  the  measured  angles,  would 
further  approximate  real  world  conditions. 

A  Monte  Carlo  statistical  analysis,  would  provide  a 
further  insight  to  the  accuracy  of  the  results. 

Finally,  an  adjoint  model  analysis,  would  provide  an 
excellent  result  validation  tool. 
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APPENDIX  A  -  PROPORTIONAL  NAVIGATION  CODE 


%Title 

Q, 

O 

%Author 

%Date 

%Revised 

%Proj  ect 

%Systein 

%Compiler 

%Description 

% 

% 

% 

clg 

clear 

!del  eg*. met; 
!del  cg3dm.dat; 
!del  cg3dt.dat; 
clc 

runtime=clock; 
rtod=180/pi; 
flops  (0)  ; 


Three  (3)  dimensional  Command 
Guidance  (PN) 

Dimitrios  Peppas 
10/01/92 
12/01/92 
Thesis 

Legend  3a6SX 
386  -  MATLAB  v. :  3.5m 
This  code  solves  a  3D  target/missile 
problem  using  a  proportional  navigation 
command  guided  missile  (Forward  Time 
Model)  . 


%Initialization  for  calculation  of  runtime 

%Rad- to-Degree  Conversion  factor 

%Reset  Floating  Point  Operations  Counter 
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%STATE  DEFINITIONS 


%M  i 

s  s  i 

1  e 

%ms= 

[xm 

missile 

X 

coordinate 

[ft] 

% 

xdm 

missile 

X 

velocity 

[ft/s] 

% 

ym 

missile 

y 

coordinate 

[ft] 

% 

ydm 

missile 

y 

velocity 

[ft/s] 

% 

zm 

missile 

z 

coordinate 

[ft] 

% 

zdm] 

missile 

z 

velocity 

[ft/s] 

%um= 

[xddm 

missile 

X 

acceleration 

[ft/s^2] 

% 

yddm 

missile 

y 

acceleration 

[ft/s"2] 

% 

zddm] 

missile 

z 

acceleration 

[ft/s"2] 

%Recall  ;  (ms ) dot=AM* {ms ) +BM*um 


AM= [010000 
0  0  0  0  0  0 
0  0  0  1  0  0 
0  0  0  0  0  0 
0  0  0  0  0  1 
0  0  0  0  0  0]; 
BM=[0  0  0 
10  0 
0  0  0 
0  10 
0  0  0 
0  0  1]; 
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%T  a 

r  g  e 

t 

%ts= 

[xt 

target 

X 

coordinate 

[ft] 

% 

xdt 

target 

X 

velocity 

[ft/s] 

% 

yt 

target 

y 

coordinate 

[ft] 

% 

ydt 

target 

y  velocity 

[ft/s] 

% 

zt 

target 

z 

coordinate 

[ft] 

% 

zdt] 

target 

z 

velocity 

[ft/s] 

%ut  = 

[xddt 

target 

X 

acceleration 

[ft/s*2] 

% 

yddt 

target 

y 

acceleration 

[ft/s"2] 

% 

zddt] 

target 

z 

acceleration 

[ft/s*2] 

%Recall  : 

( ts ) dot=AT* ( ts ) +BT*ut 

AT=AM; 

BT=BM; 

%Time  and  Navigation  Constants 

%ttrack  F.C.S.  tracking  constant  [sec] 

%tinc  F.C.S.  missile  command  constant  [sec] 

%N  F.C.S.  Navigation  constant  [dimensionless] 

ttrack=0 . 1 ; 

tmc=l; 

N=4; 

kl=  ( 1/ttrack)  ''2  ; 
k2=  (2/ttrack)  ; 
k= (1/tmc) ; 

%F.C.S.  Tracker  and  Filter 
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%Crks= [beta_pitch  Tracker  pitch  angle  estim.  [rad] 

%  betad_pitch  Tracker  pitch  rate  estim,  [rad/s] 

%  beta_yaw  Tracker  yaw  angle  estim.  [rad] 

%  betad_yaw]  Tracker  yaw  rate  estim,  [rad/s] 

%utr= [sigma_pitch  Missile- to-Target  pitch  angle  [rad] 

%  sigma_yaw]  Missile- to-Target  yaw  angle  [rad] 


ATR= [0  10  0 

-kl  -k2  0  0 

0  0  0  1 

0  0  -kl  -k2] ; 

BTR= [ 0  0 

kl  0 
0  0 
0  kl]  ; 

%Recall  :  ( trks) dot=ATR*trks+BTR*utr 

%  This  is  Equation  (3.12) 

%F.C.S.  Guidance  and  Autopilot 

%mc= [ gamma d_p itch  Missile  pitch  rate  command  [rad/s] 

%  gammad_yaw]  Missile  yaw  rate  command  [rad/s] 

%umc=  [betad__pitch 
%  betad_yaw] 

AMC=[-k  0 

0  -k]  ; 


BMC=[N  0 
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0  N]  ; 

%Recall  :  (me)  d.oC=AMC*mc+BMC*umc 

%  This  is  Equation  (3.30) 

%Discretization 
clt=.01;  %Integration  Interval 

[phim,  delm]  =c2d  (AM,  BM,  dt )  ; 

[phit , delt] =c2d (AT, BT, dt) ; 

[phitr , deltr] =c2d (ATR, BTR, dt ) ; 

[phime , delmc] =c2d (AMC, BMC, dt) ; 
tfinal=15.0;  %Calculation  time  range 

lcmax=tf inal/dt  +  1 ;  %Maximum  main  loop  runs 
%Initialization 
ms ( : , 1 )  =  [  0 

3000 

0 

0 

0 

0  ]  ; 

ts (:, 1) = [30000 

-999.445 

1000 

-33.315 

500 

0  ]  ; 


[sec] 


[sec] 
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tries  ( :  ,  1)  =  [0 
0 
0 

0]  ; 

me ( : , 1 )  =  [  0 

0]  ; 

Rt (l)=sqrt (ts(l,l)"2+ts(3,l)^2+ts(5,l)"2) ; 

Rm(l) =sqrt (ms (1,1) *2+ms (3,1) ^2+ms (5, 1) *2) ; 

R  (1)  =sqrt  (  (ms  (1, 1)  -  ts  (1, 1)  )  ^2+  (ms  (3, 1)  -  ts  (3 , 1)  )  ^^2  +  .  .  . 

(ms(5,l)  -ts(5,l)  )"2)  ; 
time (1) =0 ; 

%Simulation 
for  (i=l:kmax-l) 

%  Missile  and  Target  Velocities 

vt  (i)  =sqrt  (ts  (2,  i)  ''2+ts  (4,  i)  '^2+ts  (6,  i)  *2)  ; 
vm(i)  =sqrt  (ms  (2,  i)  '^2+ms  (4,  i)  '^2+ms  (6,  i)  *2)  ; 

%  Lines-of -Sight 

siginam_pitch  (i)  =atan2  (ms  (5 ,  i)  ,  sqrt  (ms  (1 ,  i)  '^2+ .  .  . 

ms(3,i)*2)); 

siginatjpitch(i)  =atan2  (ts  (5,  i)  ,  sqrt  (ts  (1,  i)  ^2  + .  .  . 

ts(3,i)"2) ) ; 

sigmam_yaw ( i ) =atan2 (ms ( 3 , i ) , ms ( 1 , i ) ) ; 
s iginat_yaw ( i )  =atan2  (ts(3,i)  ,ts(l,i)  )  ; 
sigma_pitch (i) =atan2 ( (ts (5, i) -ms (5, i) ) , . . . 
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sqrt  (  (ts  (1,  i)  ^2-ms  (1,  i)  ^^2)  +  .  .  . 
(ts(3,i)"2-ms(3,i)"2) ) ) ; 

sigma_yaw (i) =atan2 ( (ts (3 , i) -ms (3 , i) ) , (ts (1, i) -ms (1 , i) ) ) ; 
utr= [sigma_pitch ( i) 

sigma_yaw{i)  ] ; 

%  F.C.S.  Tracker  update 

trks ( : , i+1) =phitr*trks ( : , i) +deltr*utr; 

%  F.C.S.  Missile  Command  Control  update 

umc= [trks (2 , i) 

trks (4 , i) ] ; 

%  Missile  and  Target  Flight  Path  angles 

gammam_pitch (i) =atan2 (ms (6 , i) , . . . 

sqrt  (ms  (2 ,  i)  '^2+ms  (4 ,  i)  “^2)  )  ; 
gamma t_p i t ch (i) =atan2 (ts (6,  i) ,  .  .  . 

sqrt (ts (2 , i) *2+ts (4, i) ^2) ) ; 
gammam_yaw ( i ) =atan2 (ms ( 4 , i ) , ms ( 2 , i ) ) ; 
gammat_yaw ( i ) =atan2 (ts (4, i) , ts (2, i) ) ; 

%  F.C.S.  Missile  Command  update 

me ( : , i+1) =phimc*mc ( : , i) +delmc*umc; 

%  Missile  Velocity  and  Acceleration  in  Pitch  Plane 

vm_pitch(i)  =vni(i)  *cos  ( gammam_yaw ( i )  -sigmam_yaw(i)  )  ; 
am_pitch  (i)  =vm_pitch  (i)  *mc  (1,  i)  ; 

%  Missile  Pitch  Acceleration  components 

xddmjpitch(i)  =-am_pitch (i)  *sin(sigina_pitch(i)  )  *  .  .  . 
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cos (sigma_yaw ( i) ) ; 

yddm_pitch  (i)  =-ain_pitch  (i)  *sin  (sigma_pitch  ( i)  )  *.  .  . 
sin (sigma_yaw { i) ) ; 

zddm_pitch  (i)  =ain_pitch  ( i)  *cos  (sigina_pitch  ( i)  )  ; 

%  Missile  Velocity  and  Acceleration  in  Yaw  Plane 

vm_yaw(i)  =vm(i)  *cos  (gammain_pitch  { i)  )  ; 
am_yaw  ( i )  =vin_yaw  ( i )  *mc  ( 2  ,  i )  ; 

%  Missile  Yaw  Acceleration  components 

xddm_yaw ( i ) = - am_yaw ( i ) *  s in { s igma_yaw ( i ) ) ; 
yddm_yaw ( i ) =am_yaw { i ) *  cos ( s igma_yaw ( i ) ) ; 

%  Missile  Acceleration  components 

xddm  ( i )  =xddm_pitch  ( i )  +xddin_yaw  ( i )  ; 
yddm ( i ) =yddm_pi tch ( i ) +yddm_yaw ( i ) ; 
zddm(i) =zddm_pitch(i) ; 
um= [xddm(i) 
yddm  { i ) 
zddm ( i ) ] ; 

am(i) =sqrt (um(l) *2+um(2) *2+um(3) ^2) ; 

%  'Missile  update 

ms ( : , i+1) =phim*ms ( : , i) +delm*um; 

%  Target  Acceleration  components 

xddt  (i)=0;%-6.5*32.2*sin  (gainmat_yaw  ( i)  )  ; 
yddt (i)=0;%-6.5*32 . 2*cos (gammat_yaw ( i) ) ; 
zddt (i)=0;%-0.1*32 . 2*cos (gammat_pitch ( i) ) ; 
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ut= [xddt ( i) 
yddt ( i ) 
zddt ( i) ] ; 

at (i) =sqrt (ut (1) ^2+ut (2) ^2+ut (3) "2) ; 

Target  update 

ts ( : , i+1) =phit*ts ( : , i) +delt*ut; 

Time -to -go 

vt_yaw(i) =vt (i) *cos (gammat_pitch ( i) ) ; 

VC (i) =- (vt_yaw(i) *cos (gammat_yaw(i) -sigma_yaw(i) ) 
- vm_yaw { i ) *  cos ( gammam_yaw ( i ) - s igma_yaw ( i ) ) ) 
ttg (i) =R (i) /vc (i) ; 

Range  update 

Rt (i+i) =sqrt (ts (1, i+1) ^2+ts (3, i+1) ^2+ts (5, i+1) ^2) 
Rm(i+'l)  =sqrt  (ms  (1,  i+1)  ^2+ms  (3,  i+1)  "^2+013  (5,  i+1)  ^2) 
R(i  +  1)  =sqrt  (  (ms  (1,  i  +  1)  -ts(l,i+l)  )'^2  + .  .  . 

(ms  (3, i  +  1)  -  ts(3,i+l)  )'"2+.  .  . 

(ms (5, i+1) -ts (5, i+1) ) ^2) ; 

Time  update 
time (i+1) =time (i) +dt ; 

Rmiss  check 

if  (R(i)  <  R(i+1) ) 

tcpa=time ( i) ;  %Time-of -C. P.A. 


break 


end 


f lop_count=f lops; 
runtime=etime (clock, runtime) 

%F  i  1  i  n  g 

X= [ms ( 1 ,  :  )  '  ms ( 3 ,  :  )  '  ms  ( 5  ,  :  )  '  ]  ; 

Y=[ts(l,  :)  '  ts(3,  :)  '  ts(5,  :)  ']  ; 
save  cg3dm.dat  X  /ascii  ; 
save  cg3dt.dat  Y  /ascii  ; 

%Printout 

plot { ttg (l:i-l) ,R(l:i-l) ) ; 

title ('Miss  Distance  vs.  Time- to-go' ) ; 

xlabel('TTG  [sec] ' ) ;ylabel ( ' Rmiss  [ft]'); 

meta  cgl 

pause 

clg 

plot (time, ts (1, : ) , time, ms (1,;)); 

title (' X- coordinate  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( 'x-coord.  [ft]'); 

gtext ( 'Missile' ) ;gtext ( 'Target' ) ; 

meta  cg2 

pause 

clg 
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plot (time, ts (3 , : ) , time, ms (3,:)); 

title (' y- coordinate  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( 'y-coord.  [ft]') 

gtext ( 'Missile' ) ;gtext ( 'Target' ) ; 

meta  cg3 

pause 

clg 

plot (time, ts (5, : ) , time, ms (5,:)); 

title (' z-coordinate  Time  History'); 

xlabeK'Time  [sec]  ' )  ;ylabel  ( '  z-coord.  [ft]') 

gtext ( 'Missile' ) ; gtext ( 'Target' ) ; 

meta  cg4 

pause 

clg 

plot ( time, R) ; 

title ('Miss  Distance  vs.  Time'); 
XlabeK'Time  [sec]  ' )  ;ylabel  ( ' Rmiss  [ft]  ' )  ; 
meta  cg5 
pause 

clg 

plot (time, ts (2 , : ) , time, ms (2 , : ) ) ; 
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title {' x-Velocity  Time  History'); 
xlabel('Time  [sec] ' ) ;ylabel ( ' Vx  [ft/s] ' ) ; 
gtext ( 'Missile' ) ;gtext ( 'Target' ) ; 
meta  cg6 
pause 

clg 

plot (time, ts (4, : ) , time, ms (4,:)); 

title (' y-Velocity  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' Vy  [ft/s]'); 

gtext ( 'Missile' ) ; gtext ( 'Target' ) ; 

meta  cg7 

pause 

clg 

plot (time, ts (6, : ) , time, ms (6, : ) ) ; 

title (' z-Velocity  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' Vz  [ft/s]'); 

gtext ( 'Missile' ) ; gtext { 'Target' ) ; 

meta  cg8 

pause 

clg 

plot (time (1 : i) , rtod*gammam_pitch) ; 
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title ( 'Missile  Pitch  Angle  vs.  Time'); 
xlabel('Time  [sec] ' ) ; ylabel ( ' gammam_pitch  [deg] ' ) ; 
meta  cg9 
pause 

clg 

plot (time (1 : i) , rtod*gammam_yaw) ; 
title (' Missile  Yaw  Angle  vs.  Time' ) ; 
xlabel('Time  [sec] ' ) ; ylabel (' gammam_yaw  [deg] ' ) ; 
meta  cglO 
pause 

clg 

plot (time, rtod*mc (1 , : ) ) ; 

title ( 'Missile  Pitch  Rate  vs.  Time'); 

xlabel('Time  [sec] ' ) ;ylabel ( 'gammamd_pitch  [deg/s]'); 

meta  cgll 

pause 

clg 

plot (time, rtod*mc (2 , : ) ) ; 

title ( 'Missile  Yaw  Rate  vs.  Time' ) ; 

xlabel ( 'Time  [sec] ' ) ; ylabel { ' gammamd_yaw  [deg/s] ' ) ; 

meta  cgl2 
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pause 


%Following  plots  were  not  included  in  the  documentation 
%clg 

%plot (time (1 : i) , rtod*gammat_pitch) ; 

%title (' Target  Pitch  Angle  vs.  Time'); 

%xlabel { ' Time  [sec] ' ) ;ylabel { ' gammat_pitch  [deg] ' ) ; 

%meta  cgl3 

%pause 

%clg 

%plot  (time  (1 :  i)  ,  rtod*gaLmmat_yaw)  ; 

%title (' Target  Yaw  Angle  vs.  Time'); 

%xlabel ( ' Time  [sec] ' ) ;ylabel ( ' gammat_yaw  [deg] ' ) ; 

%ineta  eg  14 
%pause 

clg 

plot (time (l:i) ,vc) ; 

title (' Closing  Velocity  vs.  Time'); 

xlabel('Time  [sec] ' ) ;ylabel { ' Vc  [ft/s] ' ) ; 

meta  cgl5 

pause 

clg 
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axis ( [tcpa- . 1  tcpa+.l  0  min (R) +20] ) ; 
plot (time, R) ; 

title ('Rmiss  "Zoom"  Plot '); axis; 
xlabel('Time  [sec] ') ;ylabel (' Rmiss  [ft]'); 
meta  cgl6 
pause 

clg 

plot (time ( 1 : i) , am) ; 

title('Total  Missile  Acceleration  vs.  Time'); 
xlabel('Time  [sec]  ' )  ;ylabel  ( 'aim  [ft/s^2]'); 
meta  cgl7 
pause 

clg 

plot  (time  (1 :  i)  ,xdclm)  ; 

title ( 'Missile  x-Acceleration  vs.  Time'); 
xlabel('Time  [sec] ' ) ;ylabel ( 'xddm  [ft/s^2]'); 
meta  cgl8 
pause 

clg 

plot (time (1 : i) ,yddm) ; 

title ( 'Missile  y-Acceleration  vs.  Time' ) ; 
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xlabel  ( '  Time  [sec]  ' )  ;ylabel  { 'yddm  [f  t/s'^2]  ' )  ; 

meta  cgl9 

pause 

clg 

plot (time ( 1 : i) , zddm)  ; 

title (' Missile  z-Acceleration  vs.  Time'); 
xlabel ('Time  [sec] '); ylabel (' zddm  [ft/s^2] ' ) ; 
meta  cg20 
pause 

%Following  plots  were  not  included  in  the  documentation 
%clg 

%plot (time (1 ; i) ,at) ; 

%title ( 'Total  Target  Acceleration  vs.  Time' ) ; 

%xlabel  ( ' Time  [sec]  ' )  ;ylabel  ( ' at  [ft/s'‘2]  ' )  ; 

%meta  cg21 

%pause 

%clg 

%plot ( t ime ( 1 : i ) , xddt ) ; 

%title ( 'Target.  x-Acceleration  vs.  Time' ) ; 

%xlabel ( ' Time  [sec] ') ;ylabel ( 'xddt  [ft/s*2] ' ) ; 

%meta  cg22 
%pause 
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%clg 

%plot (time ( 1 : i ) , yddt ) ; 

%title (' Target  y-Acceleration  vs.  Time' ) ; 

%xlabel ( ' Time  [sec] ') ;ylabel ( 'yddt  [ft/s^2] ' ) ; 

%meta  cg23 

%pause 

%clg 

%plot (time (1 : i) , zddt) ; 

%title (' Target  z-Acceleration  vs.  Time' ) ; 
%xlabel  ( '  Time  [sec] ')  ;ylabel  (' zddt  [ft/s''2]'); 
%meta  cg24 
%pause 

clg 

plot ( ts (1, : ) , ts (3 , : ) , ' r' ,ms (1, : ) ,ms (3 , ; ) , ' g' ) ; 
title (' xy- Plane  Projection  of  Encounter'); 
xlabel ( ' x-axis  [f t] ' ) ;ylabel ( 'y-axis  [ft]'); 
meta  cg26 
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APPENDIX  B  -  CLOS  CODE 


%Title 

%Author 

%Date 

%Revised 

%Project 

%Systein 

%Compiler 

%Description 

% 

% 

% 

clg 

clear 

!del  clg*. met; 
!del  cl3dm,dat; 
!del  cl3dt.dat; 
clc 

runtime=clock; 
rtod=180/pi; 
flops (0)  ; 


Three  {3)D  Command  Guidance  (CLOS) 

Dimitrios  Peppas 

10/01/92 

11/30/92 

Thesis 

Legend  386SX 

386  -  MATLAB  v. :  3.5m 

This  code  solves  a  3D  target/missile 

problem  using  a  command- to -line -of -sight 

command  guided  missile  (Forward  Time 

Model)  . 


%Initialization  for  calculation  of  runtime 

%Rad- to -Degree  Conversion  factor 

%Reset  Floating  Point  Operations  Counter 
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STATE  DEFINITIONS 


%M  i  s  s  i  1  e 


%ms 

=  [xm 

missile 

X 

coordinate 

% 

xdm 

missile 

X 

velocity 

% 

ym 

missile 

y 

coordinate 

% 

ydm 

missile 

y 

velocity 

% 

zm 

missile 

z 

coordinate 

g. 

zdm] 

missile 

z 

velocity 

%uin 

=  [xddm 

missile 

X 

acceleration 

% 

yddm 

missile 

y 

acceleration 

% 

zddm] 

missile 

z 

acceleration 

%Recall  : 

(ms ) dot=AM* (ms ) +BM*um 

AM= 

[0  10 

0 

0 

0 

0  0  0 

0 

0 

0 

0  0  0 

1 

0 

0 

0  0  0 

0 

0 

0 

0  0  0 

0 

0 

1 

0  0  0 

0 

0 

0]  ; 

BM=[0  0  0 
10  0 
0  0  0 
0  10 
0  0  0 
0  0  1]; 


[ft] 

[ft/s] 

[ft] 

[ft/s] 

[ft] 

[ft/s] 

[ft/s"2] 

[ft/s^2] 

[ft/s^2] 
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%T  a  r  g  e  t 


%ts= 

[xt 

target 

X 

coordinate 

[ft] 

% 

xdt 

target 

X 

velocity 

[ft/s] 

% 

yt 

target 

y 

coordinate 

[ft] 

% 

ydt 

target 

y  velocity 

[ft/s] 

% 

zt 

target 

z 

coordinate 

[ft] 

% 

zdt] 

target 

z 

velocity 

[ft/s] 

%ut  = 

[xddt 

target 

X 

acceleration 

[ft/s^2] 

% 

yddt 

target 

y 

acceleration 

[ft/s^2] 

% 

zddt] 

target 

z 

acceleration 

[ft/s"2] 

%Recall  :  ( ts) dot=AT* ( ts) +BT*ut 

AT=AM; 

BT=BM; 

%Discretization 

dt=.01;  %Intergration  Interval  [sec] 

[phim,delm] =c2d(AM,BM,dt) ; 

[phit,delt] =c2d(AT,BT,dt) ; 

tfinal=15.0;  %Calculation  time  range  [sec] 

kmax*tf inal/dt+1 ;  %Maximum  main  loop  runs 
%Initialization 
ms ( : , 1 )  =  [  eps 
3000 
eps 
0 
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0 


0  ]  ; 

CS { : , 1)  =  [30000 

-999.445 
1000 
-33.315 
900 
0  ]  ; 

Rt  (1)  =sqrt  (ts  (1, 1)  ''2  +  ts  (3 , 1)  ^2+ts  (5, 1)  ^2)  ; 

Rm(l)  =sqrt  (ms  (1, 1)  *2+ms  (3,1)  ^2+ms  (5, 1)  "^2)  ; 

R(l) =sqrt ( (ms (1, 1) -ts (1, 1) ) ^2+ (ms (3 , 1) - ts ( 3 , 1) ) ^2+ (ms ( 5 , 1 ) - t 

s(5,l) )"2) ; 

time (1) =0; 

%Simulation 

for  (i=l:kmax-l) 

%  Missile  and  Target  Velocities 

vt  (i)  =sqrt  ( ts  (2  ,  i)  *2+ts  (4  ,  i)  ‘'2+ts  (6,  i)  '^2)  ; 
vm(i)  =sqrt  (ms  (2,  i)  ''2+ms  (4,  i)  ''2+ms  (6,  i)  ‘^2)  ; 

%  Lines -of -Sight 

sigmam_pitch (i) =atan2 (ms (5, i) , . . . 

sqrt  (ms  (1,  i)  *2+ms  [3  )  ; 

sigmat_pitch (i) =atan2 (ts (5,i) , . . . 

sqrt  ( ts  (1,  i)  '^2+ts  (3  ,  i)  '“2)  )  ; 
sigmam_yaw (i) =atan2 (ms (3 , i) ,ms (l, i) ) ; 
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sigmat_yaw(i) =atan2 (ts (3 , i) , ts (1,  i)  )  ; 
sigma_pitch(i) =atan2 ( (ts (5, i) -ms (5, i) ) , . . . 

sqrt ( (ts(l,i)^2-ms(l,i) ^2) +. . . 
(ts(3,i)"2-ms(3,i)"2) ) )  ; 

sigma_yaw ( i ) =atan2 ( ( ts { 3 , i) -ms (3 , i) ) , ( ts ( l , i) -ms ( 1 , i) ) ) ; 
%  C . R . E .  and  ( C . R . E . ) ' 

gla= (ms(3,i)*ts(5,i) -ms(5,i)*ts(3,i) ) ; 
glb=- (ms(5,i)*ts(l,i) -ms{l,i)*ts(5,i) ) ; 
glc=  (ms (1, i) *ts (3 , i) -ms (3 , i) *ts (1, i) ) ; 
gl=gla*2+glb^2+glc^2 ; 

g2a=2*gla* (ms (4,i)*ts(5,i) +ms  (3,i)*ts(6,i)-... 

ms(6,i)*ts(3,i)  -ms(5,i)*ts(4,i)  )  ; 
g2b=2*glb* (ms (6,i)*ts(l,i) +ms (5,i)*ts(2,i)-... 

ms (2  ,  i)  *ts (5 , i) -ms (1, i) *ts (6, i) ) ; 
g2c=2*glc* (ms (2 , i) *ts (3 , i) +ms (l,i)*ts(4,i)-... 

ms (4, i) ♦ts (1, i) -ms (3 , i) *ts (2, i) ) ; 
g2=g2a+g2b+g2c; 

f2= (ms (1, i) *ms (2 , i) +ms (3, i) *ms (4, i) +. . . 

ms ( 5 , i ) *ms ( 6 , i ) ) /Rt ( i ) ; 

CRE (i) =sqrt (gl) /Rt (i) ; 

CRED(i) = ( (1/2) * (g2/sqrt (gl) ) *Rt (i) - . . . 

f2*sqrt  (gl)  )  /  (Rt  (i)  ^^2)  ; 

CRE_yaw(i)  =sqrt  (ms  (1,  i)  *2+ms  (3 ,  i)  ^^2)  * .  .  . 

sin(sigmat_yaw(i) -sigmam_yaw(i) ) ; 
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CRE_pitch ( i ) =sqrt ( CRE ( i ) ^2  - CRE_yaw ( i ) ^2 ) * . . . 

sign (sigmat_pitch { i ) - sigmam_pitch ( i ) ) ; 

%  Missile  and  Target  Flight  Path  angles 

gaininam_pitch  (i)  =atan2  (ms  (6,  i)  ,  .  .  . 

sqrt (ms (2 , i) ^2+ms (4,i)*2)); 
gammat  jpitch ( i) =atan2 (ts (6, i) , . . . 

sqrt (ts(2,i)^2+ts(4,i)^2) ) ; 
gammam_yaw ( i ) =atan2 (ms ( 4 , i ) , ms ( 2 , i ) ) ; 
gammat_yaw ( i) =atan2 (ts (4 , i) , ts  i) ) ; 

%  Acceleration  Command 

acmd_yaw ( i) =- 100*CRE_yaw (i) -25*CRED ( i) ; 
acmd_pitch(i) =-100*CRE_pitch(i) -25*CRED (i) ; 

%  Missile  Velocity  and  Acceleration  in  Pitch  Plane 

vm_pitch(i) = (vm(i) *cos (gammam_yaw (i) -sigmam_yaw(i) ) ) ; 
am_pitch(i) =-acmd_pitch (i) ; 

%  Missile  Pitch  Acceleration  components 

xddm_pitch (i) =-am_pitch (i) *sin(sigma_pitch(i) ) *. . . 

cos ( sigma_yaw ( i ) ) ; 

yddm_pitch  (i)  =-am_j)itch  (i)  *sin(sigma_pitch  (i)  )  *  .  .  . 

sin(sigma_yaw(i) ) ; 

zddm_pitch (i) =am_pitch(i) *cos (sigma_pitch ( i) ) ; 

%  Missile  Velocity  and  Acceleration  in  Yaw  Plane 

vm_yaw(i)  =vm(i)  *cos  (gcLminam_pitch (i)  )  ; 
am_yaw ( i ) = - acmd_yaw ( i ) ; 
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Missile  Yaw  Acceleration  components 


xddm_yaw(i) =-am_yaw(i) *sin(sigma_yaw(i) ) ; 
yddm_yaw { i ) =am_yaw ( i ) *  cos ( s igma_yaw ( i ) ) ; 

Missile  Acceleration  components 
xddm { i ) =xddm_pitch ( i ) +xddm_yaw ( i ) ; 
yddm ( i ) =yddm_pi t ch ( i ) +yddm_yaw ( i ) ; 
zddm(i) =zddm_pitch (i) ; 
um= [xddm(i) 
yddm ( i ) 
zddm ( i ) ] ; 

am(i)  =sqrt  (um(l)  '^2+um{2)  '^2+\am(3)  '^2)  ; 

Missile  update 

ms ( : , i+1) =phim*ms { : , i) +delm*um; 

Target  Acceleration  components 
xddt  (i)  =-6.5*32.2*sin(gainmat_yaw(i) )  ;%0; 
yddt  (i)  =-6.5*32.2*cos  (gamniat_yaw(i)  )  ;%0; 
zddt (i) =-0 . 1*32 ,2*cos (gammat_pitch (i) ) ;%0; 
ut= [xddt ( i) 
yddt ( i ) 
zddt ( i ) ] ; 

at  (i)  =sqrt  (ut  (1)  *2+ut  (2)  ■^2+ut  (3)  ‘*‘2)  ; 

Target  update 

ts ( : , i+1) =phit*ts ( : , i) +delt*ut; 

Time- to -go 


vt_yaw(i) =vt (i) *cos (gammat_pitch (i) ) ; 

VC (i) =- (vt_yaw(i) *cos ( gamma t_y aw ( i) - sigma_yaw { i ) ) 
vm_yaw ( i ) *  cos ( gammam_yaw ( i ) - s igma_yaw { i ) ) ) 
ttg (i) =abs (R (i) /vc (i) ) ; 

%  Range  update 

Rt (i+1) =sqrt (ts (1, i+1) ^2+ts (3 , i+1) ^2+ts (5 , i+1) ^2) 
Rm(i+1) =sqrt (ms (1, i+1) ^2+ms (3 , i+l) ^2+ms (5 , i+1) ^2) 
R (i+1) =sqrt ( (ms (1, i+1) -ts (1, i+1) ) ^2+ . . . 

(ms (3, i+1) -ts (3, i+1) ) ^2+. . . 

(ms (5, i+1) -ts (5, i+1) ) ^2) ; 

%  Time  update 

time (i+1) =time (i) +dt; 

%  Rmiss  check 

if  (R(i)  <  R(i+1) ) 

tcpa=time (i) ;  %Time-of -C. P.A. 
break 

end 

end 

flop_count=flops; 
runtime=etime (clock, runtime) 

%F  i  1  i  n  g 

X= [ms ( 1 , : ) '  ms ( 3 , : ) '  ms ( 5 , : ) ' ] ; 

Y=[ts(l,  ;)  '  ts(3,  :)  '  ts(5,  ;)  ']  ; 
save  cl3dm.dat  X  /ascii; 
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save  cl3dt.dat  Y  /ascii; 

%PrintouC 

plot ( ttg (l:i-l)  ,R(l:i-l)  )  ; 

title ('Miss  Distance  vs.  Time- to-go' ) ; 

xlabeK'TTG  [sec]  '  )  ; ylabel  ( '  Rmiss  [ft]  '  )  ; 

meta  clgl 

pause 

clg 

plot (time, ts (1, : ) , time, ms {!,:)); 

title (' x-coordinate  Time  History'); 

xlabel('Time  [sec] ') ;ylabel ( 'x- coord,  [ft] ' ) ; 

gtext ( 'Missile' ) ;gtext ( 'Target' ) ; 

meta  clg2 

pause 

clg 

plot (time, ts (3 , : ) , time, ms  (3 , : ) ) ; 

title (' y- coordinate  Time  History'); 

xlabel('Time  [sec] ') ;ylabel ( 'y- coord,  [ft] ' ) ; 

gtext ( 'Missile' ) ; gtext ( 'Target' ) ; 

meta  clg3 

pause 
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clg 

plot (time, ts (5, : ) , time, ms  (5, : ) ) ; 

title (' z-coordinate  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' z-coord.  [ft] ' ) ; 

gtext ( 'Missile' ) ;gtext ( 'Target' ) ; 

meta  clg4 

pause 

clg 

plot ( time, R) ; 

title ('Miss  Distance  vs.  Time' ) ; 
xlabel('Time  [sec] ' ) ;ylabel ( ' Rmiss  [ft] ' ) ; 
meta  clg5 
pause 

clg 

plot (time, ts (2, : ) , time, ms (2,:)); 

title (' X- Velocity  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' Vx  [ft/s] ' ) ; 

gtext ( 'Missile' ) ; gtext ( 'Target' ) ; 

meta  clg6 

pause 

clg 
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plot (time, ts (4, : ) , time, ms (4,:)); 

title (' y- Velocity  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' Vy  [ft/s] ' ) ; 

gtext ( 'Missile' ) ;gtext ( 'Target' ) ; 

meta  clg7 

pause 

clg 

plot (time, ts (6, : ) , time, ms (6,:)); 

title (' z- Velocity  Time  History'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' Vz  [ft/s] ' ) ; 

gtext ( 'Missile' ) ; gtext ( 'Target' ) ; 

meta  clg8 

pause 

clg 

plot  (time  (1 :  i)  ,  rtod*gcimmam_pitch)  ; 

title (' Missile  Pitch  Angle  vs.  Time' ) ; 

xlabel ( 'Time  [sec] ' ) ;ylabel ( ' gammam_pitch  [deg] ' ) ; 

meta  clg9 

pause 

clg 

plot (time (1 : i) , rtod*gammam_yaw) ; 
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title (' Missile  Yaw  Angle  vs.  Time' ) ; 

xlabel ( 'Time  [sec] ' ) ;ylabel ( 'gammam_yaw  [deg] ' ) ; 

meta  clglO 

pause 

%%Following  plots  were  not  included  in  the  documentation 
%clg 

%plot (time (1 : i) , rtod*gammat_pitch) ; 

%title (' Target  Pitch  Angle  vs.  Time' ) ; 

%xlabel { ' Time  [sec] ' ) ;ylabel ( 'gammat_pitch  [deg] ' ) ; 

%meta  clgl3 

%pause 

%clg 

%plot (time (1 : i) , rtod*gammat_yaw) ; 

%title (' Target  Yaw  Angle  vs.  Time' ) ; 

%xlabel ( 'Time  [sec] ' ) ;ylabel ( 'gammat_yaw  [deg] ' ) ; 

%meta  clgl4 
%pause 

clg 

plot (time (1: i) , vc) ; 
title {' Closing  Velocity  vs.  Time'); 
xlabel ('Time  [sec] ' ) ;ylabel ( ' Vc  [ft/s] ' ) ; 
meta  clgl5 
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pause 


clg 

axis ( [tcpa- . 1  tcpa+.l  0  min{R)+20]); 
plot (time, R) ; 

title ('Rmiss  "Zoom"  Plot ' ) ;axis; 
xlabel('Time  [sec] '); ylabel (' Rmiss  [ft] ' ) ; 
meta  clgl6 
pause 

clg 

plot (time ( 1 : i ) , am) ; 

title('Total  Missile  Acceleration  vs.  Time'); 
xlabel('Time  [sec]  ' )  ;ylabel  { 'am  [ft/s'‘2]'); 
meta  clgl7 
pause 

clg 

plot (time (1 : i) ,xddm) ; 

title ( 'Missile  x-Acceleration  vs.  Time'); 
xlabel('Time  [sec] ' ) ;ylabel ( ' xddm  [ft/s*2] ' ) ; 
meta  clgl8 
pause 
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clg 

plot (time (1 : i) , yddm) ; 

title (' Missile  y-Acceleration  vs.  Time'); 
xlabel('Time  [sec] ') ;ylabel ( 'yddm  [ft/s*2]'); 
meta  clgl9 
pause 

clg 

plot (time (1: i) , zddm) ; 

title ( 'Missile  z -Acceleration  vs.  Time' ) ; 
xlabel('Time  [sec] ') ;ylabel (' zddm  [ft/s^2] ' ) ; 
meta  clg20 
pause 

%Following  plots  were  not  included  in  the  documentation 
%clg 

%plot (time (l:i) ,at)  ; 

%title (' Total  Target  Acceleration  vs.  Time'); 

%xlabel  ( '  Time  [sec]  ' )  ;ylabel  ( '  at  [ft/s'^2]'); 

%meta  clg21 

%pause 

%clg 

%plot (time { 1 ; i ) , xddt ) ; 

%title (' Target  x-Acceleration  vs.  Time'); 
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%xlabel  ( '  Time  [sec]  '  )  ;ylabel  ( '  xddt  [ft/s''2]  '  ) 

%meta  clg22 

%pause 

%clg 

%plot (time (1 ; i) ,yddt) ; 

%title (' Target  y- Acceleration  vs.  Time'); 

%xlabel ( ' Time  [sec] ' ) ;ylabel ( 'yddt  [ft/s*2] ' ) 

%meta  clg23 

%pause 

%clg 

%plot (time (1 : i) , zddt) ; 

%title (' Target  z-Acceleration  vs.  Time' ) ; 
%xlabel  ( ' Time  [sec] ')  ;ylabel  {' zddt  [ft/s"^2]') 
%meta  clg24 
%pause 

clg 

plot (ts (1, : ) , ts (3, : ) , ' r' ,ms (1, : ) ,ms (3 , : ) , 'g' ) 
title (' xy- Plane  Projection  of  Encounter'); 
xlabel ( 'x-axis  [f t] ' ) ;ylabel ( 'y-axis  [ft] ' ) ; 
meta  clg26 
pause 

clg 
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plot  (timed:!)  ,CRE_yaw)  ; 
title ( ' Yaw  CRE' ) ; 

xlabeK'Time  [sec]  '  )  ;ylabel  ( '  CRE_yaw  [ft]  '  )  ; 

meta  clg27 

pause 

clg 

plot (time (1 : i) , CRE_pitch) ; 
title ( ' Pitch  CRE' ) ; 

xlabeK'Time  [sec]  ' )  ;ylabel  ( '  CRE_pitch  [ft]  ' )  ; 

meta  clg28 

pause 

clg 

plot (time (1 : i) , CRE) ; 
title ('Total  CRE'); 

xlabel('Time  [sec] ' ) ;ylabel ( ' CRE  [ft] ' ) ; 

meta  clg29 

pause 

clg 

acmd=sqrt  (acmd_yawK2+acmd_pitchK2)  ; 
plot (time(l:i) ,acmd) ; 
title ( ' Commanded  Acc . ' ) ; 
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xlabel ( ' Time  [sec] ' ) ;ylabel ( 'acmd  [ft/s*2]'); 
meta  clg30 
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